// SPDX-License-Identifier: GPL-2.0
/* Copyright( c ) 2009-2012  Realtek Corporation.*/

#include "../wifi.h"
#include "../pci.h"
#include "../base.h"
#include "../stats.h"
#include "reg.h"
#include "def.h"
#include "phy.h"
#include "trx.h"
#include "led.h"

static u8 _rtl92de_map_hwqueue_to_fwqueue( struct sk_buff *skb, u8 hw_queue )
{
	__le16 fc = rtl_get_fc( skb );

	if ( unlikely( ieee80211_is_beacon( fc ) ) )
		return QSLT_BEACON;
	if ( ieee80211_is_mgmt( fc ) )
		return QSLT_MGNT;

	return skb->priority;
}

static long _rtl92de_translate_todbm( struct ieee80211_hw *hw,
				     u8 signal_strength_index )
{
	long signal_power;

	signal_power = ( long )( ( signal_strength_index + 1 ) >> 1 );
	signal_power -= 95;
	return signal_power;
}

static void _rtl92de_query_rxphystatus( struct ieee80211_hw *hw,
				       struct rtl_stats *pstats,
				       struct rx_desc_92d *pdesc,
				       struct rx_fwinfo_92d *p_drvinfo,
				       bool packet_match_bssid,
				       bool packet_toself,
				       bool packet_beacon )
{
	struct rtl_priv *rtlpriv = rtl_priv( hw );
	struct rtl_ps_ctl *ppsc = rtl_psc( rtlpriv );
	struct phy_sts_cck_8192d *cck_buf;
	s8 rx_pwr_all, rx_pwr[4];
	u8 rf_rx_num = 0, evm, pwdb_all;
	u8 i, max_spatial_stream;
	u32 rssi, total_rssi = 0;
	bool is_cck_rate;

	is_cck_rate = RX_HAL_IS_CCK_RATE( pdesc->rxmcs );
	pstats->packet_matchbssid = packet_match_bssid;
	pstats->packet_toself = packet_toself;
	pstats->packet_beacon = packet_beacon;
	pstats->is_cck = is_cck_rate;
	pstats->rx_mimo_sig_qual[0] = -1;
	pstats->rx_mimo_sig_qual[1] = -1;

	if ( is_cck_rate ) {
		u8 report, cck_highpwr;
		cck_buf = ( struct phy_sts_cck_8192d * )p_drvinfo;
		if ( ppsc->rfpwr_state == ERFON )
			cck_highpwr = ( u8 ) rtl_get_bbreg( hw,
						 RFPGA0_XA_HSSIPARAMETER2,
						 BIT( 9 ) );
		else
			cck_highpwr = false;
		if ( !cck_highpwr ) {
			u8 cck_agc_rpt = cck_buf->cck_agc_rpt;
			report = cck_buf->cck_agc_rpt & 0xc0;
			report = report >> 6;
			switch ( report ) {
			case 0x3:
				rx_pwr_all = -46 - ( cck_agc_rpt & 0x3e );
				break;
			case 0x2:
				rx_pwr_all = -26 - ( cck_agc_rpt & 0x3e );
				break;
			case 0x1:
				rx_pwr_all = -12 - ( cck_agc_rpt & 0x3e );
				break;
			case 0x0:
				rx_pwr_all = 16 - ( cck_agc_rpt & 0x3e );
				break;
			}
		} else {
			u8 cck_agc_rpt = cck_buf->cck_agc_rpt;
			report = p_drvinfo->cfosho[0] & 0x60;
			report = report >> 5;
			switch ( report ) {
			case 0x3:
				rx_pwr_all = -46 - ( ( cck_agc_rpt & 0x1f ) << 1 );
				break;
			case 0x2:
				rx_pwr_all = -26 - ( ( cck_agc_rpt & 0x1f ) << 1 );
				break;
			case 0x1:
				rx_pwr_all = -12 - ( ( cck_agc_rpt & 0x1f ) << 1 );
				break;
			case 0x0:
				rx_pwr_all = 16 - ( ( cck_agc_rpt & 0x1f ) << 1 );
				break;
			}
		}
		pwdb_all = rtl_query_rxpwrpercentage( rx_pwr_all );
		/* CCK gain is smaller than OFDM/MCS gain,  */
		/* so we add gain diff by experiences, the val is 6 */
		pwdb_all += 6;
		if ( pwdb_all > 100 )
			pwdb_all = 100;
		/* modify the offset to make the same gain index with OFDM. */
		if ( pwdb_all > 34 && pwdb_all <= 42 )
			pwdb_all -= 2;
		else if ( pwdb_all > 26 && pwdb_all <= 34 )
			pwdb_all -= 6;
		else if ( pwdb_all > 14 && pwdb_all <= 26 )
			pwdb_all -= 8;
		else if ( pwdb_all > 4 && pwdb_all <= 14 )
			pwdb_all -= 4;
		pstats->rx_pwdb_all = pwdb_all;
		pstats->recvsignalpower = rx_pwr_all;
		if ( packet_match_bssid ) {
			u8 sq;
			if ( pstats->rx_pwdb_all > 40 ) {
				sq = 100;
			} else {
				sq = cck_buf->sq_rpt;
				if ( sq > 64 )
					sq = 0;
				else if ( sq < 20 )
					sq = 100;
				else
					sq = ( ( 64 - sq ) * 100 ) / 44;
			}
			pstats->signalquality = sq;
			pstats->rx_mimo_sig_qual[0] = sq;
			pstats->rx_mimo_sig_qual[1] = -1;
		}
	} else {
		rtlpriv->dm.rfpath_rxenable[0] = true;
		rtlpriv->dm.rfpath_rxenable[1] = true;
		for ( i = RF90_PATH_A; i < RF6052_MAX_PATH; i++ ) {
			if ( rtlpriv->dm.rfpath_rxenable[i] )
				rf_rx_num++;
			rx_pwr[i] = ( ( p_drvinfo->gain_trsw[i] & 0x3f ) * 2 )
				    - 110;
			rssi = rtl_query_rxpwrpercentage( rx_pwr[i] );
			total_rssi += rssi;
			rtlpriv->stats.rx_snr_db[i] =
					 ( long )( p_drvinfo->rxsnr[i] / 2 );
			if ( packet_match_bssid )
				pstats->rx_mimo_signalstrength[i] = ( u8 ) rssi;
		}
		rx_pwr_all = ( ( p_drvinfo->pwdb_all >> 1 ) & 0x7f ) - 106;
		pwdb_all = rtl_query_rxpwrpercentage( rx_pwr_all );
		pstats->rx_pwdb_all = pwdb_all;
		pstats->rxpower = rx_pwr_all;
		pstats->recvsignalpower = rx_pwr_all;
		if ( pdesc->rxht && pdesc->rxmcs >= DESC_RATEMCS8 &&
		    pdesc->rxmcs <= DESC_RATEMCS15 )
			max_spatial_stream = 2;
		else
			max_spatial_stream = 1;
		for ( i = 0; i < max_spatial_stream; i++ ) {
			evm = rtl_evm_db_to_percentage( p_drvinfo->rxevm[i] );
			if ( packet_match_bssid ) {
				if ( i == 0 )
					pstats->signalquality =
						 ( u8 )( evm & 0xff );
				pstats->rx_mimo_sig_qual[i] =
						 ( u8 )( evm & 0xff );
			}
		}
	}
	if ( is_cck_rate )
		pstats->signalstrength = ( u8 )( rtl_signal_scale_mapping( hw,
				pwdb_all ) );
	else if ( rf_rx_num != 0 )
		pstats->signalstrength = ( u8 )( rtl_signal_scale_mapping( hw,
				total_rssi /= rf_rx_num ) );
}

static void rtl92d_loop_over_paths( struct ieee80211_hw *hw,
				   struct rtl_stats *pstats )
{
	struct rtl_priv *rtlpriv = rtl_priv( hw );
	struct rtl_phy *rtlphy = &( rtlpriv->phy );
	u8 rfpath;

	for ( rfpath = RF90_PATH_A; rfpath < rtlphy->num_total_rfpath;
	     rfpath++ ) {
		if ( rtlpriv->stats.rx_rssi_percentage[rfpath] == 0 ) {
			rtlpriv->stats.rx_rssi_percentage[rfpath] =
			    pstats->rx_mimo_signalstrength[rfpath];

		}
		if ( pstats->rx_mimo_signalstrength[rfpath] >
		    rtlpriv->stats.rx_rssi_percentage[rfpath] ) {
			rtlpriv->stats.rx_rssi_percentage[rfpath] =
			    ( ( rtlpriv->stats.rx_rssi_percentage[rfpath] *
			      ( RX_SMOOTH_FACTOR - 1 ) ) +
			     ( pstats->rx_mimo_signalstrength[rfpath] ) ) /
			    ( RX_SMOOTH_FACTOR );
			rtlpriv->stats.rx_rssi_percentage[rfpath] =
			    rtlpriv->stats.rx_rssi_percentage[rfpath] + 1;
		} else {
			rtlpriv->stats.rx_rssi_percentage[rfpath] =
			    ( ( rtlpriv->stats.rx_rssi_percentage[rfpath] *
			      ( RX_SMOOTH_FACTOR - 1 ) ) +
			     ( pstats->rx_mimo_signalstrength[rfpath] ) ) /
			    ( RX_SMOOTH_FACTOR );
		}
	}
}

static void _rtl92de_process_ui_rssi( struct ieee80211_hw *hw,
				     struct rtl_stats *pstats )
{
	struct rtl_priv *rtlpriv = rtl_priv( hw );
	u32 last_rssi, tmpval;

	if ( pstats->packet_toself || pstats->packet_beacon ) {
		rtlpriv->stats.rssi_calculate_cnt++;
		if ( rtlpriv->stats.ui_rssi.total_num++ >=
		    PHY_RSSI_SLID_WIN_MAX ) {
			rtlpriv->stats.ui_rssi.total_num =
						 PHY_RSSI_SLID_WIN_MAX;
			last_rssi = rtlpriv->stats.ui_rssi.elements[
				rtlpriv->stats.ui_rssi.index];
			rtlpriv->stats.ui_rssi.total_val -= last_rssi;
		}
		rtlpriv->stats.ui_rssi.total_val += pstats->signalstrength;
		rtlpriv->stats.ui_rssi.elements
			[rtlpriv->stats.ui_rssi.index++] =
			pstats->signalstrength;
		if ( rtlpriv->stats.ui_rssi.index >= PHY_RSSI_SLID_WIN_MAX )
			rtlpriv->stats.ui_rssi.index = 0;
		tmpval = rtlpriv->stats.ui_rssi.total_val /
			rtlpriv->stats.ui_rssi.total_num;
		rtlpriv->stats.signal_strength = _rtl92de_translate_todbm( hw,
			( u8 ) tmpval );
		pstats->rssi = rtlpriv->stats.signal_strength;
	}
	if ( !pstats->is_cck && pstats->packet_toself )
		rtl92d_loop_over_paths( hw, pstats );
}

static void _rtl92de_update_rxsignalstatistics( struct ieee80211_hw *hw,
					       struct rtl_stats *pstats )
{
	struct rtl_priv *rtlpriv = rtl_priv( hw );
	int weighting = 0;

	if ( rtlpriv->stats.recv_signal_power == 0 )
		rtlpriv->stats.recv_signal_power = pstats->recvsignalpower;
	if ( pstats->recvsignalpower > rtlpriv->stats.recv_signal_power )
		weighting = 5;
	else if ( pstats->recvsignalpower < rtlpriv->stats.recv_signal_power )
		weighting = ( -5 );
	rtlpriv->stats.recv_signal_power = ( rtlpriv->stats.recv_signal_power *
		5 + pstats->recvsignalpower + weighting ) / 6;
}

static void _rtl92de_process_pwdb( struct ieee80211_hw *hw,
				  struct rtl_stats *pstats )
{
	struct rtl_priv *rtlpriv = rtl_priv( hw );
	struct rtl_mac *mac = rtl_mac( rtl_priv( hw ) );
	long undec_sm_pwdb;

	if ( mac->opmode == NL80211_IFTYPE_ADHOC	||
		mac->opmode == NL80211_IFTYPE_AP )
		return;
	else
		undec_sm_pwdb = rtlpriv->dm.undec_sm_pwdb;

	if ( pstats->packet_toself || pstats->packet_beacon ) {
		if ( undec_sm_pwdb < 0 )
			undec_sm_pwdb = pstats->rx_pwdb_all;
		if ( pstats->rx_pwdb_all > ( u32 ) undec_sm_pwdb ) {
			undec_sm_pwdb = ( ( ( undec_sm_pwdb ) *
			      ( RX_SMOOTH_FACTOR - 1 ) ) +
			      ( pstats->rx_pwdb_all ) ) / ( RX_SMOOTH_FACTOR );
			undec_sm_pwdb = undec_sm_pwdb + 1;
		} else {
			undec_sm_pwdb = ( ( ( undec_sm_pwdb ) *
			      ( RX_SMOOTH_FACTOR - 1 ) ) +
			      ( pstats->rx_pwdb_all ) ) / ( RX_SMOOTH_FACTOR );
		}
		rtlpriv->dm.undec_sm_pwdb = undec_sm_pwdb;
		_rtl92de_update_rxsignalstatistics( hw, pstats );
	}
}

static void rtl92d_loop_over_streams( struct ieee80211_hw *hw,
				     struct rtl_stats *pstats )
{
	struct rtl_priv *rtlpriv = rtl_priv( hw );
	int stream;

	for ( stream = 0; stream < 2; stream++ ) {
		if ( pstats->rx_mimo_sig_qual[stream] != -1 ) {
			if ( rtlpriv->stats.rx_evm_percentage[stream] == 0 ) {
				rtlpriv->stats.rx_evm_percentage[stream] =
				    pstats->rx_mimo_sig_qual[stream];
			}
			rtlpriv->stats.rx_evm_percentage[stream] =
			    ( ( rtlpriv->stats.rx_evm_percentage[stream]
			      * ( RX_SMOOTH_FACTOR - 1 ) ) +
			     ( pstats->rx_mimo_sig_qual[stream] * 1 ) ) /
			    ( RX_SMOOTH_FACTOR );
		}
	}
}

static void _rtl92de_process_ui_link_quality( struct ieee80211_hw *hw,
					     struct rtl_stats *pstats )
{
	struct rtl_priv *rtlpriv = rtl_priv( hw );
	u32 last_evm, tmpval;

	if ( pstats->signalquality == 0 )
		return;
	if ( pstats->packet_toself || pstats->packet_beacon ) {
		if ( rtlpriv->stats.ui_link_quality.total_num++ >=
		    PHY_LINKQUALITY_SLID_WIN_MAX ) {
			rtlpriv->stats.ui_link_quality.total_num =
			    PHY_LINKQUALITY_SLID_WIN_MAX;
			last_evm = rtlpriv->stats.ui_link_quality.elements[
				rtlpriv->stats.ui_link_quality.index];
			rtlpriv->stats.ui_link_quality.total_val -= last_evm;
		}
		rtlpriv->stats.ui_link_quality.total_val +=
						 pstats->signalquality;
		rtlpriv->stats.ui_link_quality.elements[
			rtlpriv->stats.ui_link_quality.index++] =
						 pstats->signalquality;
		if ( rtlpriv->stats.ui_link_quality.index >=
		    PHY_LINKQUALITY_SLID_WIN_MAX )
			rtlpriv->stats.ui_link_quality.index = 0;
		tmpval = rtlpriv->stats.ui_link_quality.total_val /
		    rtlpriv->stats.ui_link_quality.total_num;
		rtlpriv->stats.signal_quality = tmpval;
		rtlpriv->stats.last_sigstrength_inpercent = tmpval;
		rtl92d_loop_over_streams( hw, pstats );
	}
}

static void _rtl92de_process_phyinfo( struct ieee80211_hw *hw,
				     u8 *buffer,
				     struct rtl_stats *pcurrent_stats )
{

	if ( !pcurrent_stats->packet_matchbssid &&
	    !pcurrent_stats->packet_beacon )
		return;

	_rtl92de_process_ui_rssi( hw, pcurrent_stats );
	_rtl92de_process_pwdb( hw, pcurrent_stats );
	_rtl92de_process_ui_link_quality( hw, pcurrent_stats );
}

static void _rtl92de_translate_rx_signal_stuff( struct ieee80211_hw *hw,
					       struct sk_buff *skb,
					       struct rtl_stats *pstats,
					       struct rx_desc_92d *pdesc,
					       struct rx_fwinfo_92d *p_drvinfo )
{
	struct rtl_mac *mac = rtl_mac( rtl_priv( hw ) );
	struct rtl_efuse *rtlefuse = rtl_efuse( rtl_priv( hw ) );
	struct ieee80211_hdr *hdr;
	u8 *tmp_buf;
	u8 *praddr;
	u16 type, cfc;
	__le16 fc;
	bool packet_matchbssid, packet_toself, packet_beacon = false;

	tmp_buf = skb->data + pstats->rx_drvinfo_size + pstats->rx_bufshift;
	hdr = ( struct ieee80211_hdr * )tmp_buf;
	fc = hdr->frame_control;
	cfc = le16_to_cpu( fc );
	type = WLAN_FC_GET_TYPE( fc );
	praddr = hdr->addr1;
	packet_matchbssid = ( ( IEEE80211_FTYPE_CTL != type ) &&
	     ether_addr_equal( mac->bssid,
			      ( cfc & IEEE80211_FCTL_TODS ) ? hdr->addr1 :
			      ( cfc & IEEE80211_FCTL_FROMDS ) ? hdr->addr2 :
			      hdr->addr3 ) &&
	     ( !pstats->hwerror ) && ( !pstats->crc ) && ( !pstats->icv ) );
	packet_toself = packet_matchbssid &&
			ether_addr_equal( praddr, rtlefuse->dev_addr );
	if ( ieee80211_is_beacon( fc ) )
		packet_beacon = true;
	_rtl92de_query_rxphystatus( hw, pstats, pdesc, p_drvinfo,
				   packet_matchbssid, packet_toself,
				   packet_beacon );
	_rtl92de_process_phyinfo( hw, tmp_buf, pstats );
}

bool rtl92de_rx_query_desc( struct ieee80211_hw *hw,	struct rtl_stats *stats,
		struct ieee80211_rx_status *rx_status,
		u8 *pdesc8, struct sk_buff *skb )
{
	__le32 *pdesc = ( __le32 * )pdesc8;
	struct rx_fwinfo_92d *p_drvinfo;
	u32 phystatus = get_rx_desc_physt( pdesc );

	stats->length = ( u16 )get_rx_desc_pkt_len( pdesc );
	stats->rx_drvinfo_size = ( u8 )get_rx_desc_drv_info_size( pdesc ) *
				 RX_DRV_INFO_SIZE_UNIT;
	stats->rx_bufshift = ( u8 )( get_rx_desc_shift( pdesc ) & 0x03 );
	stats->icv = ( u16 )get_rx_desc_icv( pdesc );
	stats->crc = ( u16 )get_rx_desc_crc32( pdesc );
	stats->hwerror = ( stats->crc | stats->icv );
	stats->decrypted = !get_rx_desc_swdec( pdesc );
	stats->rate = ( u8 )get_rx_desc_rxmcs( pdesc );
	stats->shortpreamble = ( u16 )get_rx_desc_splcp( pdesc );
	stats->isampdu = ( bool )( get_rx_desc_paggr( pdesc ) == 1 );
	stats->isfirst_ampdu = ( bool )( ( get_rx_desc_paggr( pdesc ) == 1 ) &&
				      ( get_rx_desc_faggr( pdesc ) == 1 ) );
	stats->timestamp_low = get_rx_desc_tsfl( pdesc );
	stats->rx_is40mhzpacket = ( bool )get_rx_desc_bw( pdesc );
	stats->is_ht = ( bool )get_rx_desc_rxht( pdesc );
	rx_status->freq = hw->conf.chandef.chan->center_freq;
	rx_status->band = hw->conf.chandef.chan->band;
	if ( get_rx_desc_crc32( pdesc ) )
		rx_status->flag |= RX_FLAG_FAILED_FCS_CRC;
	if ( !get_rx_desc_swdec( pdesc ) )
		rx_status->flag |= RX_FLAG_DECRYPTED;
	if ( get_rx_desc_bw( pdesc ) )
		rx_status->bw = RATE_INFO_BW_40;
	if ( get_rx_desc_rxht( pdesc ) )
		rx_status->encoding = RX_ENC_HT;
	rx_status->flag |= RX_FLAG_MACTIME_START;
	if ( stats->decrypted )
		rx_status->flag |= RX_FLAG_DECRYPTED;
	rx_status->rate_idx = rtlwifi_rate_mapping( hw, stats->is_ht,
						   false, stats->rate );
	rx_status->mactime = get_rx_desc_tsfl( pdesc );
	if ( phystatus ) {
		p_drvinfo = ( struct rx_fwinfo_92d * )( skb->data +
						     stats->rx_bufshift );
		_rtl92de_translate_rx_signal_stuff( hw,
						   skb, stats,
						   ( struct rx_desc_92d * )pdesc,
						   p_drvinfo );
	}
	/*rx_status->qual = stats->signal; */
	rx_status->signal = stats->recvsignalpower + 10;
	return true;
}

static void _rtl92de_insert_emcontent( struct rtl_tcb_desc *ptcb_desc,
				      u8 *virtualaddress8 )
{
	__le32 *virtualaddress = ( __le32 * )virtualaddress8;

	memset( virtualaddress, 0, 8 );

	set_earlymode_pktnum( virtualaddress, ptcb_desc->empkt_num );
	set_earlymode_len0( virtualaddress, ptcb_desc->empkt_len[0] );
	set_earlymode_len1( virtualaddress, ptcb_desc->empkt_len[1] );
	set_earlymode_len2_1( virtualaddress, ptcb_desc->empkt_len[2] & 0xF );
	set_earlymode_len2_2( virtualaddress, ptcb_desc->empkt_len[2] >> 4 );
	set_earlymode_len3( virtualaddress, ptcb_desc->empkt_len[3] );
	set_earlymode_len4( virtualaddress, ptcb_desc->empkt_len[4] );
}

void rtl92de_tx_fill_desc( struct ieee80211_hw *hw,
			  struct ieee80211_hdr *hdr, u8 *pdesc8,
			  u8 *pbd_desc_tx, struct ieee80211_tx_info *info,
			  struct ieee80211_sta *sta,
			  struct sk_buff *skb,
			  u8 hw_queue, struct rtl_tcb_desc *ptcb_desc )
{
	struct rtl_priv *rtlpriv = rtl_priv( hw );
	struct rtl_mac *mac = rtl_mac( rtl_priv( hw ) );
	struct rtl_pci *rtlpci = rtl_pcidev( rtl_pcipriv( hw ) );
	struct rtl_hal *rtlhal = rtl_hal( rtlpriv );
	struct rtl_ps_ctl *ppsc = rtl_psc( rtl_priv( hw ) );
	__le32 *pdesc = ( __le32 * )pdesc8;
	u16 seq_number;
	__le16 fc = hdr->frame_control;
	unsigned int buf_len = 0;
	unsigned int skb_len = skb->len;
	u8 fw_qsel = _rtl92de_map_hwqueue_to_fwqueue( skb, hw_queue );
	bool firstseg = ( ( hdr->seq_ctrl &
			cpu_to_le16( IEEE80211_SCTL_FRAG ) ) == 0 );
	bool lastseg = ( ( hdr->frame_control &
			cpu_to_le16( IEEE80211_FCTL_MOREFRAGS ) ) == 0 );
	dma_addr_t mapping;
	u8 bw_40 = 0;

	if ( mac->opmode == NL80211_IFTYPE_STATION ) {
		bw_40 = mac->bw_40;
	} else if ( mac->opmode == NL80211_IFTYPE_AP ||
		mac->opmode == NL80211_IFTYPE_ADHOC ) {
		if ( sta )
			bw_40 = sta->bandwidth >= IEEE80211_STA_RX_BW_40;
	}
	seq_number = ( le16_to_cpu( hdr->seq_ctrl ) & IEEE80211_SCTL_SEQ ) >> 4;
	rtl_get_tcb_desc( hw, info, sta, skb, ptcb_desc );
	/* reserve 8 byte for AMPDU early mode */
	if ( rtlhal->earlymode_enable ) {
		skb_push( skb, EM_HDR_LEN );
		memset( skb->data, 0, EM_HDR_LEN );
	}
	buf_len = skb->len;
	mapping = pci_map_single( rtlpci->pdev, skb->data, skb->len,
				 PCI_DMA_TODEVICE );
	if ( pci_dma_mapping_error( rtlpci->pdev, mapping ) ) {
		RT_TRACE( rtlpriv, COMP_SEND, DBG_TRACE,
			 "DMA mapping error\n" );
		return;
	}
	clear_pci_tx_desc_content( pdesc, sizeof( struct tx_desc_92d ) );
	if ( ieee80211_is_nullfunc( fc ) || ieee80211_is_ctl( fc ) ) {
		firstseg = true;
		lastseg = true;
	}
	if ( firstseg ) {
		if ( rtlhal->earlymode_enable ) {
			set_tx_desc_pkt_offset( pdesc, 1 );
			set_tx_desc_offset( pdesc, USB_HWDESC_HEADER_LEN +
					   EM_HDR_LEN );
			if ( ptcb_desc->empkt_num ) {
				RT_TRACE( rtlpriv, COMP_SEND, DBG_LOUD,
					 "Insert 8 byte.pTcb->EMPktNum:%d\n",
					 ptcb_desc->empkt_num );
				_rtl92de_insert_emcontent( ptcb_desc,
							  ( u8 * )( skb->data ) );
			}
		} else {
			set_tx_desc_offset( pdesc, USB_HWDESC_HEADER_LEN );
		}
		/* 5G have no CCK rate */
		if ( rtlhal->current_bandtype == BAND_ON_5G )
			if ( ptcb_desc->hw_rate < DESC_RATE6M )
				ptcb_desc->hw_rate = DESC_RATE6M;
		set_tx_desc_tx_rate( pdesc, ptcb_desc->hw_rate );
		if ( ptcb_desc->use_shortgi || ptcb_desc->use_shortpreamble )
			set_tx_desc_data_shortgi( pdesc, 1 );

		if ( rtlhal->macphymode == DUALMAC_DUALPHY &&
			ptcb_desc->hw_rate == DESC_RATEMCS7 )
			set_tx_desc_data_shortgi( pdesc, 1 );

		if ( info->flags & IEEE80211_TX_CTL_AMPDU ) {
			set_tx_desc_agg_enable( pdesc, 1 );
			set_tx_desc_max_agg_num( pdesc, 0x14 );
		}
		set_tx_desc_seq( pdesc, seq_number );
		set_tx_desc_rts_enable( pdesc,
				       ( ( ptcb_desc->rts_enable &&
					!ptcb_desc->cts_enable ) ? 1 : 0 ) );
		set_tx_desc_hw_rts_enable( pdesc, ( ( ptcb_desc->rts_enable
					  || ptcb_desc->cts_enable ) ? 1 : 0 ) );
		set_tx_desc_cts2self( pdesc, ( ( ptcb_desc->cts_enable ) ? 1 : 0 ) );
		set_tx_desc_rts_stbc( pdesc, ( ( ptcb_desc->rts_stbc ) ? 1 : 0 ) );
		/* 5G have no CCK rate */
		if ( rtlhal->current_bandtype == BAND_ON_5G )
			if ( ptcb_desc->rts_rate < DESC_RATE6M )
				ptcb_desc->rts_rate = DESC_RATE6M;
		set_tx_desc_rts_rate( pdesc, ptcb_desc->rts_rate );
		set_tx_desc_rts_bw( pdesc, 0 );
		set_tx_desc_rts_sc( pdesc, ptcb_desc->rts_sc );
		set_tx_desc_rts_short( pdesc, ( ( ptcb_desc->rts_rate <=
			DESC_RATE54M ) ?
			( ptcb_desc->rts_use_shortpreamble ? 1 : 0 ) :
			( ptcb_desc->rts_use_shortgi ? 1 : 0 ) ) );
		if ( bw_40 ) {
			if ( ptcb_desc->packet_bw ) {
				set_tx_desc_data_bw( pdesc, 1 );
				set_tx_desc_tx_sub_carrier( pdesc, 3 );
			} else {
				set_tx_desc_data_bw( pdesc, 0 );
				set_tx_desc_tx_sub_carrier( pdesc,
							mac->cur_40_prime_sc );
			}
		} else {
			set_tx_desc_data_bw( pdesc, 0 );
			set_tx_desc_tx_sub_carrier( pdesc, 0 );
		}
		set_tx_desc_linip( pdesc, 0 );
		set_tx_desc_pkt_size( pdesc, ( u16 )skb_len );
		if ( sta ) {
			u8 ampdu_density = sta->ht_cap.ampdu_density;
			set_tx_desc_ampdu_density( pdesc, ampdu_density );
		}
		if ( info->control.hw_key ) {
			struct ieee80211_key_conf *keyconf;

			keyconf = info->control.hw_key;
			switch ( keyconf->cipher ) {
			case WLAN_CIPHER_SUITE_WEP40:
			case WLAN_CIPHER_SUITE_WEP104:
			case WLAN_CIPHER_SUITE_TKIP:
				set_tx_desc_sec_type( pdesc, 0x1 );
				break;
			case WLAN_CIPHER_SUITE_CCMP:
				set_tx_desc_sec_type( pdesc, 0x3 );
				break;
			default:
				set_tx_desc_sec_type( pdesc, 0x0 );
				break;

			}
		}
		set_tx_desc_pkt_id( pdesc, 0 );
		set_tx_desc_queue_sel( pdesc, fw_qsel );
		set_tx_desc_data_rate_fb_limit( pdesc, 0x1F );
		set_tx_desc_rts_rate_fb_limit( pdesc, 0xF );
		set_tx_desc_disable_fb( pdesc, ptcb_desc->disable_ratefallback ?
				       1 : 0 );
		set_tx_desc_use_rate( pdesc, ptcb_desc->use_driver_rate ? 1 : 0 );

		/* Set TxRate and RTSRate in TxDesc  */
		/* This prevent Tx initial rate of new-coming packets */
		/* from being overwritten by retried  packet rate.*/
		if ( !ptcb_desc->use_driver_rate ) {
			set_tx_desc_rts_rate( pdesc, 0x08 );
			/* set_tx_desc_tx_rate( pdesc, 0x0b ); */
		}
		if ( ieee80211_is_data_qos( fc ) ) {
			if ( mac->rdg_en ) {
				RT_TRACE( rtlpriv, COMP_SEND, DBG_TRACE,
					 "Enable RDG function\n" );
				set_tx_desc_rdg_enable( pdesc, 1 );
				set_tx_desc_htc( pdesc, 1 );
			}
		}
	}

	set_tx_desc_first_seg( pdesc, ( firstseg ? 1 : 0 ) );
	set_tx_desc_last_seg( pdesc, ( lastseg ? 1 : 0 ) );
	set_tx_desc_tx_buffer_size( pdesc, ( u16 )buf_len );
	set_tx_desc_tx_buffer_address( pdesc, mapping );
	if ( rtlpriv->dm.useramask ) {
		set_tx_desc_rate_id( pdesc, ptcb_desc->ratr_index );
		set_tx_desc_macid( pdesc, ptcb_desc->mac_id );
	} else {
		set_tx_desc_rate_id( pdesc, 0xC + ptcb_desc->ratr_index );
		set_tx_desc_macid( pdesc, ptcb_desc->ratr_index );
	}
	if ( ieee80211_is_data_qos( fc ) )
		set_tx_desc_qos( pdesc, 1 );

	if ( ( !ieee80211_is_data_qos( fc ) ) && ppsc->fwctrl_lps ) {
		set_tx_desc_hwseq_en( pdesc, 1 );
		set_tx_desc_pkt_id( pdesc, 8 );
	}
	set_tx_desc_more_frag( pdesc, ( lastseg ? 0 : 1 ) );
	RT_TRACE( rtlpriv, COMP_SEND, DBG_TRACE, "\n" );
}

void rtl92de_tx_fill_cmddesc( struct ieee80211_hw *hw,
			     u8 *pdesc8, bool firstseg,
			     bool lastseg, struct sk_buff *skb )
{
	struct rtl_priv *rtlpriv = rtl_priv( hw );
	struct rtl_pci *rtlpci = rtl_pcidev( rtl_pcipriv( hw ) );
	struct rtl_ps_ctl *ppsc = rtl_psc( rtlpriv );
	struct rtl_hal *rtlhal = rtl_hal( rtlpriv );
	u8 fw_queue = QSLT_BEACON;
	dma_addr_t mapping = pci_map_single( rtlpci->pdev,
		    skb->data, skb->len, PCI_DMA_TODEVICE );
	struct ieee80211_hdr *hdr = ( struct ieee80211_hdr * )( skb->data );
	__le16 fc = hdr->frame_control;
	__le32 *pdesc = ( __le32 * )pdesc8;

	if ( pci_dma_mapping_error( rtlpci->pdev, mapping ) ) {
		RT_TRACE( rtlpriv, COMP_SEND, DBG_TRACE,
			 "DMA mapping error\n" );
		return;
	}
	clear_pci_tx_desc_content( pdesc, TX_DESC_SIZE );
	if ( firstseg )
		set_tx_desc_offset( pdesc, USB_HWDESC_HEADER_LEN );
	/* 5G have no CCK rate
	 * Caution: The macros below are multi-line expansions.
	 * The braces are needed no matter what checkpatch says
	 */
	if ( rtlhal->current_bandtype == BAND_ON_5G ) {
		set_tx_desc_tx_rate( pdesc, DESC_RATE6M );
	} else {
		set_tx_desc_tx_rate( pdesc, DESC_RATE1M );
	}
	set_tx_desc_seq( pdesc, 0 );
	set_tx_desc_linip( pdesc, 0 );
	set_tx_desc_queue_sel( pdesc, fw_queue );
	set_tx_desc_first_seg( pdesc, 1 );
	set_tx_desc_last_seg( pdesc, 1 );
	set_tx_desc_tx_buffer_size( pdesc, ( u16 )skb->len );
	set_tx_desc_tx_buffer_address( pdesc, mapping );
	set_tx_desc_rate_id( pdesc, 7 );
	set_tx_desc_macid( pdesc, 0 );
	set_tx_desc_pkt_size( pdesc, ( u16 )( skb->len ) );
	set_tx_desc_first_seg( pdesc, 1 );
	set_tx_desc_last_seg( pdesc, 1 );
	set_tx_desc_offset( pdesc, 0x20 );
	set_tx_desc_use_rate( pdesc, 1 );

	if ( !ieee80211_is_data_qos( fc ) && ppsc->fwctrl_lps ) {
		set_tx_desc_hwseq_en( pdesc, 1 );
		set_tx_desc_pkt_id( pdesc, 8 );
	}

	RT_PRINT_DATA( rtlpriv, COMP_CMD, DBG_LOUD,
		      "H2C Tx Cmd Content", pdesc, TX_DESC_SIZE );
	wmb();
	set_tx_desc_own( pdesc, 1 );
}

void rtl92de_set_desc( struct ieee80211_hw *hw, u8 *pdesc8, bool istx,
		      u8 desc_name, u8 *val )
{
	__le32  *pdesc = ( __le32 * )pdesc8;

	if ( istx ) {
		switch ( desc_name ) {
		case HW_DESC_OWN:
			wmb();
			set_tx_desc_own( pdesc, 1 );
			break;
		case HW_DESC_TX_NEXTDESC_ADDR:
			set_tx_desc_next_desc_address( pdesc, *( u32 * )val );
			break;
		default:
			WARN_ONCE( true, "rtl8192de: ERR txdesc :%d not processed\n",
				  desc_name );
			break;
		}
	} else {
		switch ( desc_name ) {
		case HW_DESC_RXOWN:
			wmb();
			set_rx_desc_own( pdesc, 1 );
			break;
		case HW_DESC_RXBUFF_ADDR:
			set_rx_desc_buff_addr( pdesc, *( u32 * )val );
			break;
		case HW_DESC_RXPKT_LEN:
			set_rx_desc_pkt_len( pdesc, *( u32 * )val );
			break;
		case HW_DESC_RXERO:
			set_rx_desc_eor( pdesc, 1 );
			break;
		default:
			WARN_ONCE( true, "rtl8192de: ERR rxdesc :%d not processed\n",
				  desc_name );
			break;
		}
	}
}

u64 rtl92de_get_desc( struct ieee80211_hw *hw,
		     u8 *p_desc8, bool istx, u8 desc_name )
{
	__le32 *p_desc = ( __le32 * )p_desc8;
	u32 ret = 0;

	if ( istx ) {
		switch ( desc_name ) {
		case HW_DESC_OWN:
			ret = get_tx_desc_own( p_desc );
			break;
		case HW_DESC_TXBUFF_ADDR:
			ret = get_tx_desc_tx_buffer_address( p_desc );
			break;
		default:
			WARN_ONCE( true, "rtl8192de: ERR txdesc :%d not processed\n",
				  desc_name );
			break;
		}
	} else {
		switch ( desc_name ) {
		case HW_DESC_OWN:
			ret = get_rx_desc_own( p_desc );
			break;
		case HW_DESC_RXPKT_LEN:
			ret = get_rx_desc_pkt_len( p_desc );
		break;
		case HW_DESC_RXBUFF_ADDR:
			ret = get_rx_desc_buff_addr( p_desc );
			break;
		default:
			WARN_ONCE( true, "rtl8192de: ERR rxdesc :%d not processed\n",
				  desc_name );
			break;
		}
	}
	return ret;
}

bool rtl92de_is_tx_desc_closed( struct ieee80211_hw *hw,
			       u8 hw_queue, u16 index )
{
	struct rtl_pci *rtlpci = rtl_pcidev( rtl_pcipriv( hw ) );
	struct rtl8192_tx_ring *ring = &rtlpci->tx_ring[hw_queue];
	u8 *entry = ( u8 * )( &ring->desc[ring->idx] );
	u8 own = ( u8 )rtl92de_get_desc( hw, entry, true, HW_DESC_OWN );

	/* a beacon packet will only use the first
	 * descriptor by defaut, and the own bit may not
	 * be cleared by the hardware
	 */
	if ( own )
		return false;
	return true;
}

void rtl92de_tx_polling( struct ieee80211_hw *hw, u8 hw_queue )
{
	struct rtl_priv *rtlpriv = rtl_priv( hw );
	if ( hw_queue == BEACON_QUEUE )
		rtl_write_word( rtlpriv, REG_PCIE_CTRL_REG, BIT( 4 ) );
	else
		rtl_write_word( rtlpriv, REG_PCIE_CTRL_REG,
			       BIT( 0 ) << ( hw_queue ) );
}
